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Note 1: This is a short (20 pages) 

tutorial. An extended (57 pages) 

tutorial that also includes Kalman 
filtering is available at 
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Navigation 


Navigation: 
Estimate the position, orientation and velocity of a vehicle 


Inertial navigation: 
Inertial sensors are utilized for the navigation 





Inertial Sensors 





Based on inertial principles, acce/eration and angular velocity are 
measured. 


e Always relative to inertial space 
e Most common inertial sensors: 
— Accelerometers 
— Gyros 


Accelerometers 


By attaching a mass to a spring, measuring its deflection, we get a 
simple accelerometer. 





Sensitive axis 





Figure: Gade (2004) 





Accelerometers (continued) 





Gravitation is also measured (Einstein's principle of equivalence) 
Total measurement called specific force 


Using 3 (or more) accelerometers we can form a 3D specific force 
measurement: fa 
IB 


This means: Specific force of the body system (B) relative inertial space (/), 
decomposed in the body system. 


Gyros 


Gyros measure angular velocity relative inertial space: 


Measurement principles include: 
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Figure: Caplex (2000) Figure: Bose (1998) 





Coriolis-effect 

e MEMS 

e “Tuning fork” 
e “Wine glass” 





Figure: Titterton & Weston (1997) 


IMU 





Three gyros and three accelerometers are normally combined in an 
inertial measurement unit (IMU) 
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Example: 
Honeywell HG1700 ("medium quality"): 


e 3 accelerometers, accuracy: 1 mg 
e 3ring laser gyros, accuracy: 1 deg/h 
e Rate of all 6 measurements: 100 Hz 
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Foto: FFI 


Inertial Navigation 





An IMU (giving Siz and © p) is sufficient to navigate relative to inertial 
space (no gravitation present), given initial values of velocity, position 
and attitude: 


— Integrating the sensed acceleration will give velocity. 
— A second integration gives position. 


— To integrate in the correct direction, attitude is needed. This is 
obtained by integrating the sensed angular velocity. 


In terrestrial navigation (close to the Earth) we compensate for 
gravitation, and rotation of the Earth 


Equations integrating the gyro and accelerometer measurements into 
velocity, position and orientation are called navigation equations 


Inertial Navigation System (INS) 





The combination of an IMU and a computer running navigation equations is 
called an Inertial Navigation System (INS). 


Angular _.B 


: Attitude, K,, or roll/pitch/yaw 
velocity, “1B 


ar 
: Velocity, V pp 





Specitic f? 
ccelero- (Orca, ie : Horizontal „ or longitude/ 
meters- : position, M latitude 
3 Depth, Z 





Due to errors in the gyros and accelerometers, an INS will have unlimited drift in 
velocity, position and attitude. 


Categorization: 
IMU technology and IMU performance 


Class Position Gyro Accelerometer | Gyro bias 
performance | technology | technology 
Military 1nmi/24h | ESG, RLG, Servo < 0.005°/h | < 30 ug 
grade” FOG accelerometer 
Navigation 1nmi/h RLG, FOG Servo 0.01°/h 50 ug 
grade accelerometer, 
Vibrating beam 
Tactical >10nmi/h | RLG, FOG Servo 1°/h 1 mg 
grade accelerometer, 
Vibrating beam, 
MEMS 


AHRS NA MEMS, RLG, | MEMS 1 - 10°/h 1 mg 
FOG, Coriolis 

Control NA Coriolis MEMS 10 - 1000°/h | 10mg 

system 









Aided inertial navigation system 





‘Reset 7T | 










To limit the drift, an INS 
is usually aided by 
other sensors that 
provide direct 
measurements of for 
example position and 
velocity. 


The ditferent 
measurements are 
blended in an optimal 
manner by means of 
a Kalman filter. 
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Smoothed 
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The INS and aiding sensors have 
complementary characteristics. 


Optimal Smoothing 





Optimal estimate when also using future measurements 


2D trajectory in meters, Pie 






































Smoothing gives: 0 
— Improved accuracy 295 
— Improved robustness 290 
— Improved integrity 285 
— Estimate in accordance = 280 
with process model 5 275 
270 

265 

260 

Example from HUGIN 1000: ee 
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Figure: NavLab 


Typical position estimate example 
(simulation) 


Position in meters (OMe) 


vs time 








—— True trajectory 
——— Measurement 
-... Calculated value from navigation equations 
—. Estimate from real-time Kalman filter 
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— Smoothed estimate 
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Position measurement total error: 5 m (1 o) 
Navigation equation reset ca each 107 sec 
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Figure: NavLab 


Gyrocompassing 





Gyrocompassing 
— The concept of finding North by static conditions, x- and y-gyros 
measuring the direction of in the horizontal plane: 


Earth's axis of rotation relative 
to inertial space @,, 


— Earth rotation is measured by 
means of gyros 


~._§} z-gyro méasurement 







`~- Earth's axis of rotation 


e An optimally designed AINS | 
inherently gyrocompasses x-gyro measurement 
optimally when getting position or : 
velocity measurements (better than ria Ls 
a dedicated gyrocompass/motion North 
sensor). 


F Latitude 


y-gyro measurement 


What is NavLab? 


NavLab (Navigation Laboratory) is one common tool for solving a variety 


of navigation tasks. 


Development started in 


1998 


Main focus during 
development: 

— Solid theoretical 
foundation 
(competitive edge) 


Structure: 
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Filtered 
estimates 
and 
covariance 
matrices 





Smoothed 
estimates 


covariance 
matrices 
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Simulator (can be replaced by Estimator (can interface with 
real measurements) simulated or real measurements) 


Simulator 
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e Trajectory simulator x10 


— Can simulate any trajectory 
in the vicinity of Earth 


— No singularities 


e Sensor simulators 


— Most common sensors with 
their characteristic errors are 
simulated 

— All parameters can change 
with time 


— Rate can change with time 
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Figure: NavLab 






Verification of Estimator aii 
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Navigating aircraft with NavLab 


Cessna 172, 650 m height, much turbulence 
simple GPS ls I “ino IMU spec. aaa, 
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Lined imager data Positioned with NavLab (abs. accuracy: ca 1 m verified) 


NavLab Usage 


Main usage: 


Navigation system research and development 

Analysis of navigation system 

Decision basis for sensor purchase and mission planning 
Post-processing of real navigation data 

sensor evaluation 

Tuning of navigation system and sensor calibration 


Users: 


Research groups (e.g. FFI (several groups), NATO Undersea Research 
Centre, QinetiQ, Kongsberg Maritime, Norsk Elektro Optikk) 


Universities (e.g. NTNU, Unik) 


Commercial companies (e.g. C&C Technologies, Geoconsult, FUGRO, 
Thales Geosolutions, Artec Subsea, Century Subsea) 


Norwegian Navy 


Vehicles navigated with NavLab: AUVs, ROVs, ships and aircraft 


« For more details, see www.naviab.net 





Conclusions 





e An aided inertial navigation system gives: 
— optimal solution based on all available sensors 
— all the relevant data with high rate 


Compare this with dedicated gyrocompasses, motion sensors etc 
that typically gives sub-optimal solutions, often with a subset of 
data 


e If real-time data not required, smoothing should always be used to 
get maximum accuracy, robustness and integrity 


